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1.  Introduction  and  System  Requirements 

The  work  described  in  this  report  is  part  of  a larger  effort 
to  demonstrate  the  feasibility  of  using  a digital  microprocessor  to 
guide  and  control  a small  homing  missile.  The  objective  of  this  portion 
of  the  project  is  to  define  the  baseline  processing  requirements  to  be 
imposed  on  the  microprocessor.  For  this  purpose,  the  microprocessor  is 
defined  as  a small  stored  program  digital  computer  with  a word  length 
of  16  bits  or  less,  memory  capacity  of  about  1000  words  or  less,  and  a 
memory  access  time  on  the  order  of  2 microseconds.  The  reason  for 
establishing  these  guidelines  is  that  the  processor  must  eventually 
go  on  board  the  missile  and  must  be  small  and  inexpensive.  Hopefully, 
tne  microprocessor  will  replace  present  analog  circuitry  which  is 
alleged  to  be  less  reliable,  less  flexible,  bulkier,  and  more  costly. 
These  hardware  limitations  influence  the  choice  of  algorithms  to  be 
implemented  in  the  available  memory  and,  more  importantly,  computation 
speed  is  severely  bounded. 

The  missile  chosen  for  this  feasibility  demonstration  is  of  the 
HELLFIRE  class  and  the  project  has  been  named  the  Modular  Missile 
Digital  Autopilot.  It  was  decided  that  a good  comparison  between  the 
present  analog  system  and  the  proposed  digital  system  could  be  obtained 
by  converting  the  analog  equations  to  difference  equations  which  can  be 
programmed.  The  performance  of  the  analog  system  will  provide  a stan- 
dard against  which  the  performance  of  the  digital  system  can  be  judged. 
If  the  difference  ecuations  can  be  executed  at  rates  and  word  lengths 
such  that  the  results  obtained  from  both  systems  agree  within  certain 
established  boundaries,  then  a satisfactory  set  of  processing  require- 
ments for  the  microprocessor  will  have  been  derived.  It  is  recognized 
that  a simple  conversion  of  an  analog  system  to  a digital  system  is 
not  necessarily  the  best  approach  to  the  design  of  a digital  system. 

A better  and  more  effective  system  for  microprocessor  implementation 
can  probably  be  developed  in  the  digital  domain  starting  from  basic 
missile  system  performance  requirements.  However,  such  a development 
is  a lengthy  task,  that  would  require  extensive  analysis  and  simulation 
work.  It  is  believed  that  the  analog  to  digital  approach  offers  a 
quicker  and  more  predictable  chance  of  success  and  its  performance 
and  processing  requirements  will  offer  standards  against  which  any  more 
sophisticated  algorithms  developed  in  the  future  may  be  judged. 

C rtair.  guidelines  were  used  in  accepting  or  rejecting  candidate 
digital,  implementations.  It  seemed  reasonable  that  the  system -phase 
margi  should  not  be  degraded  by  more  than  5 degrees  and  the  gain  mar- 
gin tr  more  than  1 dB.  Digital  system  performance  should  not  deterio- 
rate below  the  loop  crossover  frequencies  and  the  data  rates  should  b 
high  enough  so  that  some  high  frequency  roll-off  is  provided  above 
crossover.  Furthermore,  it  was  obvious  from  the  beginning  that  the 
primary  processing  load  would  be  multiplications  and  a reasonable  est 
mate  for  this  operation  in  a microprocessor  is -50  microseconds.  Doub- 
ling t!  is  time  to  allow  for  all  other  types  of  processing  set  a limit 
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of  10,000  multiplications  per  second  as  a maximum  allowable  load.  These 
figures  were  used  in  rejecting  or  retaining  certain  approaches  to  the 
digital  system  design. 


2.  The  Analog  System 

The  original  analog  guidance  and  control  system  is  shown  in 
Figure  1.  The  system  contains  loops  of  two  basic  types:  a 3-axis 

inner  gyro  loop  and  a 2-axis  outer  seeker  loop.  The  gyro  loop  response 
is  shaped  by  the  control  compensators  F^(s)  in  pitch  and  yaw  and  F^(s) 

in  roll.  The  compensator  double  zero  furnishes  adequate  lead  angle  to 
stabilize  the  loop  and  the  poles  contribute  roll-off  as  well  as  easing 
the  realizability  problem  with  standard  circuit  components.  The  seeker 
related  functions,  F^(c)  and  F2(s),  Prov^e  integration  of  the  angula*. 

rate  error  signals,  a low  frequency  lead  zero,  and  signal  filtering 
by  way  of  a triple  pole.  The  microprocessor  is  supposed  to  perform  all 
of  the  functions  represented  by  F (s),  F (s),  F (s),  and  F (s). 


3.  Possible  Approaches 

The  objective  of  this  task  now  becomes  the  derivation  of  a 
set  of  programmable  difference  equations  which  can  be  executed  at  iter- 
ation rates  such  that  the  performance  of  the  digital  system  approximates 
that  of  the  analog  system  within  the  guidelines  mentioned  under 
Section  1.  There  exists  a variety  of  potential  solutions  to  this  pro- 
blem many  of  which  might  be  satisfactory.  Several  of  these  solutions 
were  examined. 


a.  State  Variable  Formulation 


The  state  variable  approach  is  ^urte  general  and  consists 
of  the  following  procedure: 


1)  Decompose  the  analog  system  transfer  functions  into  a system 
of  simple  integrators,  gains,  and  summing  points. 

2)  Write  down  the  system  vector-matrix  first  order  differential 
equation  of  the  form 

[X]  = [F] [X]  + [G] [U]  (3-1) 


using  the  integrator  outputs  ac  state  variables. 

3)  Obtain  the  corresponding  difference  equation 

[X]N  = [$][X]N-1  + [r][UlN-l 


(3-2) 


L. 


using  any  of  several  methods  for  computing  the  and  P matrixes.  The 
series  expressions 


2 rn1  t1- 


(3-3) 


are  especially  useful  if  the  job  is  done  on  a digital  computer.  Usually, 
the  system  output  may  be  obtained  satisfactorily  using  the  analog  obser- 
vation equation  gains 


[Y]N  = [H][X]n  . (3-4) 

The  system  characteristics  can  be  examined  for  different  F and  G matrixes 
| that  result  from  various  decompositions  of  the  analog  system  and  the 
effect  of  the  update  interval  T can  be  studied.  Alternative  equations 
that  are  occasionally  useful  are 

tO(T)l  = f"1  isil]  - [F]}"1 

and 

T 

fPlT)]  = / [® (r ) ] dr  [G]  . (3-6) 

o 

These  equations  were  used  in  checking  some  of  the  work  done  with  the 
simpler  functions. 

b.  z -Trans form  Method 

The  -z-transform  approach  as  used  herein  generates  a fre- 
quency domain  transfer  function  such  as 

-1  -2  -3 

A z + A„  z + A»  z + 

_ _ __  (3-7) 

1 + z + B2  z + B3  z + 

Cross  multiplication  and  conversion  of  the  resulting  equation  to  the 
time  domain  result  in  an  expression  such  as 

yN  = A1  Vl  + A2  UN-2  + A3  UN-3  + 

(3-8) 

(B1  yN-l  + B2  yN-2  + B3  yN-3  T 

which  gives  the  output  y in  terms  of  past  outputs  and  inputs.  The 


y(z) 

u(z) 


t=T 


(3-5) 
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transfer  function  y(z)/u(z)  may  require  considerable  labor  in  its 
derivation.  Very  simple  analog  functions  can  be  found  in  tables.  Com- 
plex functions  have  to  be  decomposed  into  simpler  terms  that  can  be 
handled  separately  and  then  recombined  to  yield  a single  recursive 
feedback  form  such  as  Equation  (3-7). 

c.  Pole-Zero  Design 

Pole-zero  design  in  the  digital  domain  can  save  a lot  of 
time  depending  on  how  the  problem  is  stated.  If  the  objective  is  to 
duplicate  the  performance  of  an  analog  transfer  function  as  best  as  is 
possible,  then  a logical  thing  to  do  is  to  duplicate  its  poles  and 
zeros  in  the  digital  domain.  This  is  certainly  reasonable  if  the  ana- 
log system  was  designed  in  the  frequency  domain  in  the  first  place, 
which  is  nearly  always  the  case  for  filters  and  compensators.  A trans- 
fer function  such  as 


F(s)  = — (3-9) 

(s  + b)(s  + 2 &cj  s + u ) 


would  appear  as 


F(z)  = 


(z 


-aT 


-at.  , 2 . -6cjT  ,v  / c2  , -25wT, 

e )(z  - 2z  e cos  uiyi  - 6 + e ) 


(3-10) 


The  functions  F(s)  and  F(z)  have  poles  and  zeros  at  identical  locations 
in  the  s-nlane.  However,  F(z)  has  an  infinite  number  of  additional 
p^les  and  zeros  outside  the  primary  strip  at  intervals  separated  by 
2"/T  along  lines  parallel  to  the  jw-axis  through  the  original  poles  and 
zeros.  If  frequency  response  matching  is  established  at  a goal  for  the 
analog  and  digital  systems,  this  simplistic  approach  is  about  as  good 
as  any.  It  can  be  argued  that  this  approach  is  the  same  as  that  of  the 
z-translorm  described  previously,  but  the  concept  is  a little  different 
and  more  direct.  The  proper  gain  has  to  be  inserted  so  that  F(z)  and 
F(s)  behave  similarly.  In  all  the  methods  described  some  zero  order 
hold  compensation  may  be  necessary.  In  the  end,  pole-zero  matching 
was  used  in  the  control  compensator. 


4.  Recursive  Feedback  Formulation 

Early  in  the  task,  the  recursive  feedback  formulation  exempli- 
fied by  Equation  (3-8)  appeared  to  be  a very  desirable  approach  to  the 
problem.  The  reason  for  this  is  the  small  number  of  computations 
required  relative  to  those  of  algorithms  derived  by  state  variable 
methods.  This  type  of  formulation,  however,  turned  out  to  be  highly 
susceptible  to  word  length  effects.  Originally,  this  was  blamed  on 
the  z-transform  but  the  fault,  of  course,  lies  in  the  form  of  the  final 
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result  end  not  in  the  technique  used.  Difference  equations  derived 
by  state  variables  can  also  be  combined  into  this  form  and  would  suffer 
from  the  same  malady.  Conversely,  a z-transform  derived  digital  sys- 
tem might  work  at  acceptably  short  word  lengths  if  left  in  a decomposed 
form.  However,  the  total  number  of  computations  required  will  increase 
and  the  advantage  of  this  approach  over  the  state  variable  method  will 
be  lost.  Obviously,  a pole-zero  design  might  also  suffer  from  word 
length  problems  unless  it  is  decomposed. 

The  performance  of  the  recursive  feedback  formulation  derived  from 
a z-transform  transfer  function  suffered  spectacular  degradation  as  the 
data  rate  approached  that  rate  required  for  a satisfactory  approxima- 
tion of  the  analog  system.  This  was  very  bad  since  it  was  believed  from 
the  beginning  that  high  execution  rates  and  short  word  lengths  with  pre- 
dominantly single  precision  arithmetic  would  be  required  of  the  micropro- 
cessor. The  work  that  follows  is  an  example  of  the  problem  that  was 
encountered. 

The  version  of  the  fii.ter/integrator  transform  to  be  discussed  was 
formulated  by  letting 


F(z)  = (1  - z'1)  2 


1.5 


+ 1 


(4-1) 


This  function  was  taken  directly  from  Figure  1 by  preceding  the  function 

S r + 1 

(4-2) 


F1F2(S)  = 


1.5 


s (iJ+  l) 


by  a zero  order  hold  whose  transfer  function  is 

-sT 


Ws) 


1 - e 


(4-3) 


The  reason  for  the  fictitious  hold  circuit  was  that  the  z-transform 
derived  version  of  the  filter/integrator  was  being  used  as  a check  or. 
the  state  variable  version.  The  function  in  Equation  (4-1)  was  decom- 
posed as 


7/15  _1_  7/15 

s 2 " s + 15 
s 


8 

is  + 15)2 


135 

(s  + 15)3 


(4-4) 
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The  transforms  of  the  individual  terms  were  found  in  tables  and  terms 
recombined  to  give 


F(z)  = 


3 2 

A1  z + A2  z + A^  z + A^ 

~4  3 2 

z + B z + B,.  z + B.  z + B, 
1 z 3 4 


in  which 


7 X2 

Al=  [-15  - 8X  - !35  — 

= If  + 8T  - 135  y e"30T  + -p 

. 7 -45T  f 7 

A3  ~ "TF  6 + [-15  " 13T  4 


OT  , or  T -15T  7 

8T  - 135  — e + — + T 


+ 13T  + 270 


13T  + 270  — e 


T2]  -30T 

~ J 6 


, JA  or  ior  T -15T 

+ — “ 8T  “ 135  ~ e 


A4  ■ [h'T_ 


-45T  7 

e + + 8T  - 135  j 


B = -(1  + 3 e"15T) 


R _ , -15T  -15T 

B2_de  (1  + e ) 


R _ -301  -15T 

~ "e  (3  + e ) 


B4  e ' 

The  frequency  response  of  Equation  (4-5)  can  be  studied  bv  letting 
jaiT  . 

z =>  e xn  which  T is  the  data  interval.  The  time  response  can  be 
gotten  from  t..e  corresponding  difference  equation 

yN  " A1  UN-1  + A2  V2  + A3  uN-3  + \ UN-4  < 


B1  yN-l  " B2  yN-2  " B3  yN-3  " B4  yK-4 
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Equation  (4-14)  is  what  would  be  programmed  in  the  microprocessor  for 
the  function  F^  F^Cs).  There  are  only  8 multiplications  and  7 additions 

required  in  the  execution  of  this  equation.  The  response  is  identical, 
theoretically,  to  that  of  the  state  variable  equations  to  be  presented 
later.  The  state  variable  method  will  generally  be  found  to  require  a 
few  more  operations  in  its  execution.  After  signal  cross  over  in  the 
q and  r channels  of  Figure  1,  two  equations  such  as  Equations  (4-14) 
are  all  that  are  required  for  seeker  error  signal  integration  and 
filtering. 

Frequency  response  data  were  taken  using  a Hewlett/Packard  9830 
programmable  calculator.  The  results  are  summarized  in  Figures  2 and  3. 
The  response  of  the  original  analog  system  represented  by  Equation 
(4-2)  is  shown  for  comparison.  The  response  is  shown  as  a function  of 
the  data  interval,  T,  and  the  number  of  significant  decimal  digits  in 
the  numerator  and  denominator  coefficients  of  Equation  (4-5). 

For  the  purpose  of  drawing  conclusions  from  Figures  2 and  3,  recall 
that  only  the  coefficients  have  been  rounded  off.  In  practice,  the 
variables  would  not  only  be  rounded  but  also  scaled.  It  is  believed 
that  maintaining  four  decimal  digits  of  precision  in  a 16-bit  word 
length  processor  is  difficult  if  not  impossible.  Five  or  six  place 
precision  is  out  of  the  question.  Furthermore,  a data  rate  of  50  sam- 
ples per  second  or  greater  is  highly  desirable  in  the  seeker  loop  to 
prevent  deterioration  of  the  system  phase  margin  (this  will  be  elabo- 
rated on  later  in  this  report).  What  one  would  like  to  see  is  an  algo- 
rithm whose  response  agrees  with  that  of  the  analog  system  up  to  at 
least  20  radians  per  second  to  within  1 uB  in  gain  and  2 or  3 degrees 
in  phase  margin  not  counting  the  zero  order  hold  delay.  Most  of  the 
latter  problem  can  be  compensated  for  if  the  data  rate  is  high  enough. 

It  would  be  encouraging  if  this  agreement  was  possible  with  as  few  as 
three  significant  decimal  digits  for  the  coefficients.  The  3-digit 
data  taken  for  this  algorithm  were  so  bad  that  it  was  not  plotted.  The 
4-digit  data  are  unsatisfactory  at  20  samples  per  second  and  5-digit 
data  show  deterioration  at  50  samples  per  second,  it  was  concluded  from 
this  information  that  the  recursive  feedback  formulation  is  unsatisfac- 
tory for  use  in  the  microprocessor. 

Step  response  data  were  taken  using  Equation  (4-14)  and  the  conclu- 
sions regarding  performance  degrauarion  with  word  length  agreed  with 
those  from  the  frequency  response  data.  The  specific  cause  of  the  poor 
short  word  length  performance  of  the  recursive  feedback  form  lies  in 
the  magnitudes  of  the  individual  numerator  and  denominator  terms  rela- 
tive to  their  algebraic  sums.  The  dominator  coefficients,  in  particu- 
lar, remain  on  the  order  of  unity  as  the  data  rate  increases  but  the 
sum  of  the  terms  becomes  very  small.  Leading  digits  are  lost  when  the 
sum  is  formed. 
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Actually,  the  problem  with  the  z-transform  based  recursive  feedback 
formulation  was  first  noticed  before  word  length  was  aver  considered. 

At  very  high  data  rates  (2000  samples  per  second  or  greater)  it  was 
seen  that  the  digital  system  output  got  worse  but  had  consistently 
improved  as  the  rate  increased  up  to  that  point.  Word  length  is  not 
normally  a problem  in  the  H/P  9830  since  it  uses  four  16-bit  words 
for  variable  storage  and  maintains  12  significant  decimal  digits  of 

-99  99 

accuracy  between  10  to  10  . This  is  better  chan  some  large  general 

purpose  computers  in  single  precision.  These  considerations  led  to  an 
early  investigation  of  word  length  effects  in  this  algorithm  and  caused 
its  subsequent  abandonment.  The  z-transform  (recu'^ive  feedback  form) 
word  length  matter  is  mentioned  in  several  references  but  its  severity 
was  not  appreciated  prior  to  this  investigation. 
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5.  The  State  Variable  System 


The  analog  system  shown  in  Figure  1 can  be  represented  by 
17  state  variables.  Three  of  these  are  in  the  roll  channel  leaving 
14  in  the  pitch/yaw  channels.  The  basic  inputs  to  the  system  are  the 
seeker  error  rate  measurements,  X and  X^  and  the  gyro  pitch,  yaw,  and 

roll  angles  designated  6 , and  0.  The  outputs  are  z^,  z^>  and  z^  so 

that  the  summing  junctions  preceding  the  actuators  remain  analog.  This 
arrangement  will  minimize  the  number  of  digital  to  analog  converters 
required. 


Several  potential  approaches  to  the  state  variable  conversion  of 
the  analog  system  to  an  equivalent  digital  system  were  examined.  Only 
the  final  one  will  be  discussed  in  detail.  In  the  end,  a parallel 
oriented  decomposition  of  the  analog  system  was  used.  The  system  was 
separated  into  two  q/r  channel  guidance  f ilter/integrator  blocks  and 
three  pitch/yaw/roll  gyro  compensator  blocks.  This  means  that  a ficti- 
tious zero  order  hold  was  inserted  at  the  summing  junctions  at  the 
inputs  to  the  pitch/yaw  compensators.  The  reasons  for  choosing  this 
arrangement  are: 


a)  A parallel  oriented  system  is  computationally  efficient  in 
that  coupling  among  the  states  is  minimized. 

b)  The  compensators  require  higher  execution  rates  than  the 
filter/integrators  and  it  is  easier  to  fulfill  this  requirement 
if  the  compensator  states  are  not  coupled  back  into  the  filter/ 
integrators. 

c)  The  gyro  inputs  have  to  come  through  a real  zero  order  hold  in 
the  digital  system  so  it  should  be  acceptable  to  assume  a hold 
on  the  filter  integrator  outputs  with  which  they  are  summed. 
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d)  The  fact  that  the  filter/ integrator  outputs  go  through  the  com- 
pensators is  incidental  anyway.  The  seeker  error  signals  could 
be  processed  and  added  to  the  compensator  outputs  at  the 
actuator  junction. 


form 


The  q/r  channel  filter  integrator  after  signal  crossover  has  the 
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The  flow  diagrams  for  this  system  are  shown  in  Figure  4 and  the 
state  equations  are 


x„ 


0 0 0 0 

0 -b  0 0 

0 b -b  0 

0 0 b -b 


x„ 


LX4J 


&ql 


(5-2) 


with  the  output  given  by 

y,  •*  V1!  - K3  <*2  + *3>  + K4  *, 


(5-3) 


Before  crossover,  F^(s)  is 


by-passed  and  the  equations  are 


F2(s) 


(5-4) 
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Notice  that  at  crossover,  x,  is  initialized  to  x,.  and  x.  = 0.  Also. 

4 2 2 

the  gravity  and  turning  rate  biases  have  been  neglected.  They  will  be 
inserted  in  the  final  equations.  The  equations  were  handled  this  way 
so  that  the  software  is  simplified.  Using  the  F and  G matrixes  in 
Equation  (5-2)  in  the  expressions  for  S>  and  I Equations  (3-3)  give  the 
following  matrixes. 


1 

0 

0 

0 

V 

0 

A22 

0 

0 

B21 

[0]  = 

0 

A32 

A33 

0 

[r]  = 

B31 

0 

A42 

A43 

A44- 

-B41- 

(5-7) 


In  these  matrixes,  it  was  observed  that 


A22  " 1 B21  1 " A32  B31 


(5-8) 


- 1 - A, 


A32  ‘ B41 


Also,  = T where  T is,  the  update  time  interval.  These  equations  can 

be  used  to  reduce  the  number  of  multiplications  required  in  executing 
the  final  set  of  difference  equations. 

The  frequency  response  of  the  digital  system  was  examined  from  the 
matrix  equation 


from  which 


ix]N  = [®][x]N-1  + [r][ujN1 


[x(z)i  = {z[il  - [0]}'1[r][u(z)l 


(5-9) 


(5-10) 


Since  U is  a scaler,  the  individual  state  variable  responses  are  calcu- 
lated from 


“ [X(jw)l  = {ejwT[I]  - [$]}  [r]  . (5-11) 

The  output  response  is 

X /X  X X 

J (jw)  = ^ ~ (jw)  - K3  (jw)  + (jw)|  + K/+  — (jw)  (5-12) 
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after  crossover.  Before  crossover 
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Figure  7.  Gyro  compensator  flow  diagram. 


and  the  output  is 


yL  = Ax9  + B"  xiu + Cxn  • ( 

Again  using  Equations  (5-2)  the  matrixes  for  the  difference  equation 
were  found  to  be 


-G  0 0 

D, , 

11 

11 

o c,„ 

[r]  = 

D„, 

22  23 

21 

0 C „ 

32  33^ 

3 ij 

The  following  relationships  exist  among  the  matrix  elements  and  the 
gains  were  redefined  as 


Values  for  the  analog  systen.  gains  found  from  the  partial  fraction  expan- 
sion ara 

A = 119.1012658 

By  = -63.67088608  (5-23) 

C = -118.1012658 

Again  the  frequency  response  of  the  digital  system  was  found  by 
solving  the  matrix  equation 

£ [X  (jw)]  = (ejWt  [I]  - [0]}"1  IF]  (5-24) 


with  the  output 


1 (jw)  = A — (jco)  + Bv  (jw)  + C ( j'o)  . (5-25) 

u u u u 

This  was  done  for  various  data  intervals  T.  The  results  are  shown 
in  Figures  8 through  10  and  should  be  compared  with  the  analog  system 
response  which  is  also  plotted 

The  roll  compensator  whose  transfer  function  is 


is  very  similar  to  the  picch/yaw  compensator.  The  $ and  r matrixes  are, 
in  fact,  identical.  The  gains  are  replaced  by 

A = 86.6032033 

B7  = -43.77938517  (5-27) 

C = -85.6032033 

Basically,  the  work  in  this  section  defines  the  difference  equations 
to  be  used  for  the  control  compensator  and  filter/ integrator  software. 

The  r-channel  equations  are  the  same  as  for  the  q-channel  except  that 
the  q-channel  has  gravity  and  turning  rate  bias  added.  The  final  equa- 
tions are  shown  in  Appendix  A which  was  previously  published  as  Inter- 
nal Technical  Note  ITN-RGG-1-75,  Digital  Autopilot  Software  System 
Specification  (T-6  Version),  January  1975. 
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Figure  8.  Pitch  gyro  compensator  magnitude  response  state  variable  form 


Among  other  state  variable  based  systems  which  were  examined  briefly, 
a series  oriented  system  whose  F matrix  had  very  few  off-diagonal  non- 
zero elements  was  examined.  However,  the  <J>  matrix  for  this  type  of  sys- 
tem has  a relatively  large  number  of  off-diagonal  non-zero  elements 
caused  by  the  fact  that  state  variables  toward  the  output  are  coupled 
all  the  way  back  to  the  input.  If  these  off-diagonal  elements  cannot 
be  neglected,  the  computational  load  for  this  system  is  much  greater 
than  for  a parallel  based  one. 


6.  Modification  of  the  State  Variable  System 

It  can  now  be  seen  that  the  difference  equations  represented 
by  (5-3),  (5-7),  and  (5-9)  for  the  f ilter/integrators  and  (5-20),  (5-21), 
and  (5-9)  for  the  gyro  compensators  are  not  entirely  satisfactory. 

Several  factors  lead  one  to  this  conclusion  among  which  are  the  number 
of  multiplications  in  the  equations,  the  anticipated  speed  of  a state 
of  the  art  microprocessor,  the  loop  crossover  frequency  data  given  in 
Appendix  B,  and  the  information  in  the  frequency  response  curves.  Recall 
that  an  upper  limit  or  10,000  multiplications  per  second  was  predicted 
for  the  microprocessor.  From  the  crossover  frequency  data  and  fre- 
quency response  curves,  it  appears  that  performance  balance  can  be 
maintained  among  the  various  algorithms  by  making  the  roll  update  rate 
highest,  the  pitch/yaw  rates  about  1/2  the  roll  rate  and  the  q/r  channel 
rates  about  1/4  to  1/2  the  pitch/yaw  rates.  Using  these  rate  ratios 
weighted  by  the  number  of  multiplications  in  each  set  of  equations 
showed  that  the  phase  margin  decrease  of  5 degrees  could  not  be  met  in 
any  loop  even  at  20,000  mult- c-lications  per  second.  It  was  decided 
that  either  the  rates  had  to  be  reduced  or  the  number  of  operations 
in  the  equations  decreased  if  the  digital  autopilot  were  to  be  success- 
ful. 


The  primary  problem  in  the  digital  system  is  a failure  to  faith- 
fully reproduce  the  analog  system's  phase  angle.  Magnitude  is  generally 
not  much  of  a problem.  Phase  angle  problems  are  caused  by: 

a)  Lag  caused  by  zero  order  holds 

b)  Failure  of  the  digital  system  to  adequately  realize  the  analog 
system  zeros 

c)  Poles  and  zeros  in  the  digital  system  outside  the  primary 
strip  in  the  s-plane 

d)  Quantization  effects  due  to  word  length. 

Zero  order  hold  lag  can  be  compensated  for  by  a prediction.  This 
could  be  done  using  the  transition  matrix  but  this  can  increase  the 
number  of  computations  to  the  extent  that  not  much  is  gained  by  the 
accompanying  allowable  decrease  in  data  rate.  The  prediction  method 
should  be  very  simple,  preferably  in  this  case  requiring  only  a 
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multiplication  or  two.  It  was  assumed  that  the  system  timing  would  be 
such  that  a full  zero  order  hold  would  appear  at  the  microprocessor 
input  in  addition  to  the  one  required  at  the  output.  These  zero  order 
holds  were  compensated  for  by  a simple  linear  prediction  on  the  output. 
This  prediction  is  given  by 


ZN  2 


y«  - y 


N-l 


(6-1) 


which  essentially  consists  of  three  additions.  The  compensated  output 

is  z.,  and  y and  y are  the  last  two  uncompensated  outputs.  The 
N N N-l 

magnitude  and  phase  characteristics  of  this  equation  are  shown  in 
Figure  11.  The  response  for  two  zero  order  holds  for  which  this  equa- 
tion compensates  is  shown  also.  In  passing,  the  characteristics  of  the 
compensating  equation  for  a single  zero  order  hold 

ZS  « 3/2  y„  - 1/2  y[M  (6-2) 

is  shown  in  Figure  11.  It  can  be  seen  that  the  full  interval  predictor 
removes  all  but  about  0.5  degree  or  less  of  the  zero  order  hold  lag  up  to 
coT  = 0.2  at  a gain  cost  of  1/3  dB  or  less.  At  uT  = 0.4,  the  remaining 
phase  lag  is  3 degrees  or  less  at  a gain  cost  of  1.2  dB  or  less.  The 
full  interval  compensation  given  by  Equation  (6-1)  was  added  to  each  of 
th*>  equation  sets  in  the  q-channel,  r-channel,  pitch,  yaw,  and  roll.  The 
manner  in  which  the  equations  are  specified  cause  a slight  over  compensa- 
tion of  1/2  the  pitch/yaw  gyro  interval  in  the  q/r  channels.  This  causes 
no  significant  effect  in  the  seeker  loop  and  is  slightly  beneficial. 


The  zero  shift  problem  was  primarily  troublesome  in  the  gyro  com- 
pensators. The  main  purpose  of  each  compensator  is  to  provide  enough 
lead  angle  near  the  zero  dB  crossover  frequency  by  way  of  a double  real 
zero  to  stabilize  each  gyro  loop.  In  pitch  and  yaw,  this  zero  was 
placed  at  30  radians  per  second  and  in  roll  at  35  radians  per  second. 

If  the  output  expression  for  y^  uses  the  analog  system  gains  A,  By,  and 

C it  is  found  that  the  location  of  this  double  zero  in  the  primary  strip 
in  the  s-plane  depends  on  the  update  rate  in  the  digital  system. 

Although  the  magnitude  of  the  zero  remained  about  right,  it  breaks 
into  a complex  pair.  The  locus  of  the  comples  pair  is  shown  in 
Figure  12  for  picch  and  yaw  as  a function  of  the  data  interval.  The 
difference  in  phase  lead  for  the  double  real  zero  and  the  complex 
pair  is  shown  in  Figure  13.  Unfortunately,  the  lag  due  to  the  fact 
that  the  zero  is  complex  was  close  co  a maximum  at  about  the  system 
crossover  frequency  at  what  was  thought  to  be  the  maximum  acceptable 
data  rate  and  the  lag  amounted  to  15  to  20  degrees. 

This  led  to  a decision  to  recompute  the  system  gains  A,  By,  and  C 
such  that  the  digital  system  has  a double  real  zero  at  30  radians  per 
second  in  pitch  and  yaw.  A similar  thing  was  done  in  roll  for  the 
zero  at  35  radians  per  second.  This  procedure  may  appear  formidable 
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o>T  (rad) 

Figure  11.  Zero  order  hold  and  compensating  predictor  responses. 


Figure  12.  S-plane  compensator  zero  locus. 


FREQUENCY  (rad/sec) 

Figure  13.  Phase  angle  difference  between  double  real  zero  and  complex  pair. 


but  it  required  only  a few  instructions  added  to  the  frequency  response 
program  on  the  9830  calculator.  Conceptually,  the  matrix  equation 

[X  (z)]  = <z[l]  - [0]}"1  [T]  [U  (z)]  (6-3) 

was  solved  for  the  states  and  the  output  equation 

y(z)  = A x9(z)  + By  x1Q(z)  + C x^(z)  (6-4) 


was  forced  to  have  a numerator  term  equal  to 


, -or. 2 

(z  - e ) 


by  equating  coefficients  and  solving  for  the  required  gains  A,  B7,  and 
C.  These  recomputed  gains  are  the  ones  specified  in  Appendix  A for  the 
given  data  rates  in  pitch,  yaw,  and  roll. 


Nc  attempt  was  made  to  compensate  for  pole  and  zero  effects  outside 
the  primary  strip  and,  in  general,  nothing  can  be  done  about  them. 

Word  length  is  discussed  in  the  next  section. 


7.  Word  Length 

Word  length  selection  for  the  digital  autopilot  was  not  con- 
sidered a firm  goal  for  this  part  of  the  project.  Final  word  length 
will  be  a natural  result  obtained  from  the  feasibility  demonstration. 

A 16-bit  specification  was  tentatively  set  from  the  beginning  for  the 
microprocessor  based  on  prior  experience  and  the  desire  to  have  a 
flexibility  not  available  at  shorter  word  lengths.  This  investigation 
was  undertaken  to  insure  that  single  precision  16-bit  arithmetic  was 
indeed  adequate,  to  get  data  on  A/D  quantization  levels,  and  to  see 
if  a shorter  word  length  might  be  allowable. 

The  HP  9830  is  limited  in  word  length  studies  since  it  appears  to 
be  a decimal  machine  to  the  operator.  There  is  no  provision  for  machine 
language  accessibility  and  therefore  no  bit  manipulations.  Word  length 
effects  were  studied  by  truncating  decimal  digits  in  £/Jtem  gains  and 
matrix  elements  and,  to  a limited  extent,  by  octal  digit  truncation  of 
the  same  constants.  The  results  of  this  truncation  shown  in  Figures 
14  through  16  for  the  seeker  f ilter/integrator  and  the  gyro  compensator 
indicate  that  the  state  variable  derived  formulation  is  relatively 
insensitive  to  short  word  length  quantization  errors  as  compared  with 
the  recursive  feedback  formulation  discussed  earlier.  The  two-digit 
data  for  the  gyro  compensator  varied  too  radically  to  be  plotted. 

Errors  for  the  four-digit  curves  were  too  small  to  plot.  On  the  basis 
of  these  curves,  it  was  concluded  that  three  significant  octal  digits 
were  all  that  are  needed  for  the  system  gains  and  matrix  elements. 
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FREQUENCY  (rad/sec) 

Figure  15.  Seeker  f ilter/integrator  word  length  error  state  variable  lorm  2 decimal  digits 


le  form  3 decimal  d 


Furthermore,  this  same  quantization  level  should  be  adequate  for  the 
system  variables  and,  therefore,  10-bit  A/D  conversion  will  be  adequate. 
Actually,  the  only  known  computations  that  require  full  16-bit  precision 
are  the  gyro  output  equations  for  y^,  y^,  and  y^  in  which  a small  alge- 
braic sum  is  formed  after  multiplication  of  individual  variables  by 
high  gains.  The  next  critical  computation  is  the  integration  accuracy 
in  indirect  fire  in  which  the  missile  must  be  turned  so  as  to  bring  the 
target  within  the  seekers'  field  of  view.  A 12-bit  processor  could 
yield  precision  close  to  one  part  in  1000,  however,  which  should  be  more 
than  adequate  for  this  computation. 


8.  Software  Analysis  Summary 

As  noted  previously,  the  software  system  specification  based 
on  the  analyses  discussed  in  this  report  is  included  as  Appendix  A. 
Before  a final  decision  could  be  made  on  data  rates,  information  was 
needed  concerning  loop  crossover  frequencies  and  the  internal  seeker 
characteristics.  The  modeling  and  analyses  relative  to  this  work  are 
detailed  in  Appendix  B.  A software  flow  diagram  is  shown  in  Appendix  A, 
Figure  A-2.  In  summary,  the  software  consists  of  two  nearly  identical 
sets  of  difference  equations  for  the  q and  r channel  filter/integrators , 
two  identical  sets  of  equations  for  the  pitch  and  yaw  compensators,  and 
a set  of  equations  for  the  roll  compensator.  These  equations  are  based 
on  the  state  variable  equations  discussed  in  Section  5.  These  equations 
were  modified  for  zero  order  hold  delay  and  corrected  for  unsatisfactory 
zero  locations  in  the  gyro  compensators.  With  these  modifications  to 
the  basic  state  variable  derived  equations,  frequency  response  error 
curves  are  shown  in  Figures  17  through  21.  From  these  curves,  rates 
were  chosen  to  be  500  cycles  per  second  in  roll,  250  cycles  per  second 
in  pitch  and  yaw,  and  71.4  cycles  per  second  for  the  q/r  channel  soft- 
ware. The  71.4  cycles  per  second  rate  is  one  update  every  7 roll  cycles 
and  takes  into  account  the  fact  that  it  is  desirable  to  place  this  rate 
between  expected  sidebands  from  the  20  Hz  sampler  in  the  seeker.  This 
problem  is  discussed  further  in  Appendix  B. 

The  equations  could  be  slightly  simplified  by  neglecting  terms  that 
are  not  significant.  The  gyro  compensator  pole,  for  example,  at  1000 
radians  per  second  is  unnecessary  in  the  digital  system  and  could  have 
been  omitted.  A few  other  terms  in  the  <J>  and  T matrixes  could  also 
be  neglected.  In  fact,  a first  order  approximation  to  these  matrices 
was  studied  and  only  a small  difference  in  performance  compared  to  the 
original  system  was  observed.  None  of  these  simplifications  were 
incorporated  in  the  design. 

The  specified  difference  equations  updated  at  the  designated  rates 
on  a 16-bit  microprocessor  will  not  degrade  the  system  gain  margin  more 
than  1 dB  or  the  phase  margin  more  than  5 degrees.  Low  frequency  or 
Mdc"  response  is  immeasurably  affected.  The  data  rates  are  high 
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Figure  19.  Gyro  compensator  magnitude  error  final  desi 
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re  20.  Gyro  compensator  phase  error  final  dcs 


Figure  21.  Gyro  compensator  phase  error  final  design. 


enough  that  noise  problems  caused  by  a lack  of  high  frequency  roll-off 
should  not  be  encountered.  The  execution  rate  required  of  the  micro- 
processor is  high  and  might  be  eased  by  a less  conservative  software 
design  but  it  is  believed  that  a well-designed  microprocessor  using 
available  technology  can  meet  the  challenge. 


Appendix  A.  DIGITAL  AUTOPILOT  SOFTWARE  SYSTEM 
SPECIFICATION  (T-6  VERSION) 


I.  System  Requirements 

This  document  is  intended  to  serve  as  a combined  software  system 
requirement  and  specification  for  the  modular  missile  digital  autopilot. 
The  software  specified  herein  is  a digital  implementation  of  the  analog 
functions  shovm  in  Figure  A-l.  The  primary  reference  sources  for  the 
analog  system  were  North  American  Rockwell  document  772-SA- 20-72,  'Scaled 
Down  THFTY  Autopilot  Requirements"  and  Army  Missile  Command  Technical 
Report  RG-73-18.  "T6  Missile  Description."  A general  goal  to  be  met 
is  that  the  software  is  to  be  implemented  on  a state-of-the-raicroprocessor 
which  is  envisioned  as  a small  digital  machine  with  memory  access  time 
aiound  2 psec,  word  length  no  greater  than  16  bits,  and  about  a IK 
memory.  Another  goal  was  arbitrarily  established  as  a performance 
measure,  i.e.,  the  system  phase  margins  and  gain  margins  should  not  be 
degraded  more  than  5 degrees  and  1 dB  respectively  and  performance 
should  improve  over  these  figures  below  the  crossover  frequencies.  The 
specified  software  will  meet  these  goals.  The  justification  for  the 
software  described  in  this  document  will  be  given  in  an  Army  Missile 
Command  Technical  Report  to  be  published. 

II.  Comptational  Flow  Diagram 

The  digital  system  gross  computational  flow  diagram  is  shown  in 
Figure  A-2.  The  correlation  between  blocks  in  Figures  A and  A-2  is 
almost  one  to  one  with  the  main  exception  being  an  interchange  of  the 
filter/integrator  and  guidance  filter  blocks.  The  block  update  rates 
are  shown  in  Figure  A-2.  The  71.4/second  rat^  is  approximace  and 
corresponds  to  a 14-millisecond  time  internal  or  one  update  every  7 
roll  cycles.  Pitch  and  yaw  compensator*-  are  updated  every  other  roll 
cycle. 


The  inputs  to  the  digital  system  are: 

a)  \ “ seeker  ^itch  and  yaw  angular  error  rates 

b)  <^q><-'r  “ ^eeker  signal  crossover  discretes  in  pitch  and  yaw 

c)  0,  ty,  <t>  - gyro  pitch,  yaw,  and  roll  angles. 

The  catputs  from  the  digital  system  are  z^,  z^,  z ^ - pitch,  yaw,  and 
r<-ll  actuator  signals. 


In  addition,  a target  detection  discrete,  D,  and  a variable  bias, 
b,  are  required  in  the  indirect  fire  mode. 
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TARGET  DETECTION 
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III.  Difference  Equations 

The  difference  equations  to  be  executed  by  each  block  in  Figure 
A-2  are  shown  in  the  following  numbered  paragraphs.  The  paragraph 
numbers  correspond  to  the  numbers  in  the  lower  right  hand  corners  of 
the  blocks  in  Figure  A-2.  The  symbols  in  the  equations  are  identified 
in  the  glossary  of  this  appendix.  In  general,  the  subscript  "N"  indi- 
cates the  new  computed  value  of  a variable  and  "L"  indicates  the  value 
of  a variable  or  measurement  saved  from  the  previous  cycle  for  the 
variable  being  updated.  These  difference  equations  were  derived  by 
standard  state  variable  methods  and  modified  to  account  for  an  incorrect 
zero  location  and  zero  order  hold  delays. 

1.  q-Channel  Filter/integrator  Update  Time  Interval:  0.014  second 

Equations : 


X1N  “ X1L  + Bll(XqL  + 8) 

* 

*2N  = X2L  + B21(\l  ' V 


(A-l) 


Input:  \ from  seeker  A/D 

Output:  x^,  x^N  to  storage  and  q-channel  output 

Storage:  x^,  x2L 

Constants*  g,  0^, 


2.  q-Channel  Guidance  Filter  Update  Time  Interval*  0.014  second 
''Executec 

Equations : 


''Executed  only  with  = 1) 


X3N  X3L  + A32  (x2L  " X3L)  + B31  (\l  “ X3L‘) 


X4N  X4L  + A42  (X2L  " X4L')  r A32  (x3L  " X4L) 


(A-2) 


+ B41  <V  “ *4L* 


Inputs : 

\ , from  j 
qL 

Outputs : 

X3N’  X4N 

Storage: 

X3L’  X4L 

Constants 

: B31 , A 

2L 
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3.  q-Channel  Output  (C^  = 0)  Update  Time  Interval:  0.014  second 

Equations : 


yqN  ” X1N  " K1  X2N 
Z;N  = 2yqN  " yqL 

Inputs:  x^,  X2jj  from  q-jhannel  filter/integrator 

Output:  to  pitch/yaw  compensator  input  and  y to  storage 

Storage:  y _ 

qL 

Constant:  K, 


(A-3) 


4.  q-Channel  Output  (C^  = 1)  Update  Time  Interval:  0.014  second 

Equations : 


yqN  K2  X1N  “ K3  (X2N  + X3N)  + K4  X4N 


ZqN  2yqN  “ yqL 


(A-4) 


Inputs:  x1N,  x0N>  x^,  x^N  from  q-channel  filter/integrator  and  guidance 

filter 

Output:  z^N  to  pitch/yaw  compensator  and  y^N  to  storage 

Storage:  y 

qL 

Constants:  KOJ  K_,  K. 

2 3 4 

5.  r-C'nannel  Filter/integrator  Update  Time  Interval:  0.014  second 

Equations : 


xc.,  = x.T  + Bt  , K _ 
5N  oL  11  rL 


X6N  ~ X6L  + B21  (XrL  “ X6I? 
Input:  \ from  seeker  A/d 

Outputs:  x5n>  t0  storage  and  r-channel  output 

Storage:  x^,  x6L 


(A-3) 


45 


Constants: 


Bn*  B2i 

6.  r-Channel  Guidance  Filter  Update  Time  Interval:  0.014  second 

(Executed  only  with  = 1) 

Equations: 


X7N  = X7L  + A32  (X6L  “ X7LJ  + B31  (XrL  " X7LJ 


X8N  = X8L  + A42  (X6L  " X8L^  + A32  (x7L  " X8L) 


(A-6) 


+ B41  (XrL  " X8L) 


Inputs:  \ T from  seeker  A/D  and  x,  from  r-channel  filter/ integrator 

ITl*  Oli 

Outputs:  x^N>  Xg^  to  storage  and  r-channel  output  (C^  = 1) 

Storage:  x?L,  x^ 

Constants:  B^,  A A^j 


7. 


r-Channel  Output  (C^  = 0)  Update  Time  Interval:  0.014  second 

Equations : 


yrN  = X5N  " K1  X6N 
ZrN  = 2yrN  " yrL 


(A-7) 


Inputs:  x5^>  X^N  from  r-channel  filter  integrator,  to  storage 

Output:  z to  pitch/yaw  compensators  and  y^  to  storage 

Storage:  yrL 

Constant: 


8. 


r-Channel  Output  (C^  = 1)  Update  Time  Interval: 


0.014  second 


Equations : 


yrN  = K2  X5N  ” K3  (x6N  + X7Nt)  + K4  X8N 
ZrN  = 2yrN  ' yrL 


(A-8) 
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Inputs : 


xc.,,  y,„>  from  r-channel  f ilter/integrator  and 

ON  ON  7N  oN 

guidance  filter 

Outputs:  z^  to  pitch/yaw  compensator  input  and  y to  storage 

Storage.  yfL 
Constants:  K^,  K^, 


9.  Pitch/Yaw  Compensator  Input  Update  Time  Interval:  0.004 

second 

Equations : 


u,  = -z  +0+z  - if 

1 qL  L rL  L 


(j,  = - z , + fi,  - z . + V7 
2 qL  L rL  L 


(A-9) 


Inputs:  z and  z from  q/r  channel  outputs.  0 and  ^ from  pitch/yaw 

Li  IT  Li  Li  Li 


gyro  A/D's. 
‘1*  "2 


Outputs:  to  pitch/yaw  compensators 


10,  Pitch  Gyro  Compensator  Update  Time  Interval:  0.004  second 

Equations: 

X9N  = + C11  (X9L  " Ml) 

X10N  = °22  X10L  + °32  (^1  " X11L'> 


X11N  X11L  + C32  X10L  + °31  ^1  " X11L) 


(A-10) 


ylN  X11N  + K5  (X9N  " X11N)  " K6  X10N 


Z1N  = K7  (2ylN  " yiL) 


Inputs:  |.u  from  pitch  yaw  compensator  input 

Output:  z1N  to  actuator  D/A.  x9n>  x^,  xnN,  y1N  to  storage 

Storage:  x^,  x^,  XUL,  y1L 

Constants:  Cn,  C^,  C^,  D^,  K^,  Kg , K? 
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11.  Yaw  Gyro  Compensator  Update  Time  Interval:  0.004  second 

Equations: 

X12N  = + °11  (X12L  “ ^2) 

X13N  = C22  X13L  + C32  ^2  " X14L) 

X14N  = X14L  + C32  X13L  + °31  ^ 2 “ X14L)  ^ 

y2N  = X14N  + K5  (X12N  ' X14N)  ” K6  X13N 
Z2N  = K7  (2  y2N  ‘ y2L^ 

Inputs:  M2  from  pitch  yaw  compensator  input 

Outputs:  z2N  to  actuator  d/a.  x^,  x^,  x ^ , y1N  to  storage 

Storage:  x12L,  x^,  x^,  y2L 

Constants:  Cu>  C^,  D^,  K5>  Kg,  K? 

12.  Roll  Gyro  Compensator  Update  Time  Interval:  0.002  second 


Equations: 


X15N  *L  + E11  (X15L  ’ V 


X16N  E22  X16L  + E32  (°L  ' X17L} 


X17L  + E32  XlbL  + F31  (°L  “ X17L^ 


y3N  X17N  + K8  (X15N  ~ X17N}  " K9  *17N 
Z3N  = K10(2y3N  " y3L) 


Input:  4>  from  roll  gyro  A/D 

L 


Output:  z3N  to  actuator  D/A.  x^,  x^,  x^,  to  storage 

Storage:  x^,  x^,  x^,  y3L 

Constants:  Ell*  E22’  E32’  F31*  V V K10 
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IV. 


System  Initialization 


The  variables  in  the  difference  equations  are  all  initialized 


to 


zero.  At  crossover,  set  x,T  = xOT , 

*+L  2L 


8L 


= X6L* VI. * * *  X2L  X6L  = °* 


V.  Timing 


A typical  timing  diagram  is  shown  in  Figure  A-3.  In  this  diagram, 
a basic  timing  unit  is  the  2 msec  roll  cycle.  The  roll  compensate/  is 
shown  being  executed  every  cycle.  Pitch  and  yaw  compensator  executions 
are  alternated.  The  q/r  channel  software  is  assumed  to  be  divided  about 
equally  among  the  seven  cycles  allocated  to  it.  The  next  seven  cycles 
have  P and  Y interchanged.  It  is  of  some  importance  that  I/O  operations 
be  scheduled  as  shown  in  relation  to  program  execution  because  of  effects 
on  the  system  phase  margins  and  assumptions  made  in  the  difference  equa- 
tion derivation.  Variances  in  the  timing  pattern  can  be  handled  but 
might  require  modifications  in  the  output  equations.  Notice  that  there 
are  really  no  q/r  channel  analog  outputs. 


FUNCTION 

R 

P 

qi 

R/P 

I/O 

R 

Ld 

q2 

R/Y 

I/O 

R 

JL 

q3 

R/P 

I/O 

CYCLE 

NUMBER  (2  msec) 

R/Y 

R Y n I/O 

R 

P 

r2 

R/P 

I/O 

R 



Y 

2 

r3 

R/Y 

I/O 

R 

p 

} 

q/r 

I/O 

R/P 

I/O 

4 

5 

. 

7 

R.P.Y  - ROl  L/PITCH/YAW  COMPENSATOR  EXECUTION 
R/P/Y  I/O  - ROLL/PITCH/YAW  INPUT-OUTPUT 
q1,q2,q3,r1,r2,r3  - q/r  CHANNEL  EXECUTION 
q/r  I/O  - q/r  CHANNEL  INPUT-OUTPUT 


Figure  A-3.  Timing  diagram. 


VI.  Word  Length 

The  recommended  processor  word  length  is  16  bits.  All  computa- 
tions can  be  handled  satisfactorily  with  16-bit  single  precision  arith- 

metic. It  has  been  established  that  all  constants  may  be  expressed  in 
3 octal  digits  not  counting  leading  zeros.  The  critical  computations 
for  word  length  specification  are  the  compensator  output  equations  in 

which  precision  is  lost  in  the  process  of  multiplying  terms  by  high 
gains  with  subsequent  subtraction.  If  these  computations  were  done  in 

double-precision,  a 12-bit  processor  would  handle  this  job.  However, 
the  16-bit  device  is  recommended  for  the  purpose  of  this  feasibility 
demonstration. 
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VII.  Memory  Requirements 

The  total  memory  required  for  program  storage,  constant  storage, 
and  intermediate  variable  storage  should  not  exceed  500  words. 

VIII.  Instruction  Set 

The  instruction  set  may  be  very  simple  since  the  only  operations 
are  simple  additions,  subtractions,  multiplies,  and  decisions.  A divide 
is  not  required  in  the  algorithms. 

IX.  Computational  Summary 

A computational  summary  is  shown  in  Table  A-l.  Since  the  domi- 
nant load  on  the  microprocessor  load  is  expected  to  be  the  multiplica- 
tions,  it  can  be  seen  that  one  of  these  operations  must  be  executed  in 
about  100  microseconds  or  less. 


TABLE  A-l.  COMPUTATIONAL  SUMMARV 


Adds 

Deci- 

sions 

Analog 

Inputs 

Analog 

Outputs 

Rate 

(per  sec) 

q-channel 

10 

20 

1 

1 

0 

71.43 

r-channel 

10 

19 

1 

1 

0 

71.43 

Pitch  Comp 

8 

16 

1 

1 

1 

250 

Yaw  Comp 

8 

16 

1 

1 

1 

250 

Roll  Comp 

8 

13 

1 

1 

1 

500 

Total  (per  sec) 

9429 

17,286 

1143 

1143 

1000 

X.  List  of  Constants 

A list  of  constants  is  included  in  Table  A-2.  These  constants 
are  applicable  only  for  the  specified  data  rates.  Any  change  in  data 
rates  will  require  a recomputation  of  these  constants. 

XI.  Indirect  Fire  Mode 

The  indirect  fire  mode  has  been  somewhat  ignored  since  the  pri- 
mary purpose  of  this  task  is  to  see  if  a microprocessor  can  stabilize 
and  guide  the  missile.  Its  implementation,  would  require  a direct/ 
indirect  fire  decision,  a test  for  target  detection,  and  provision  for 
the  turning  rate  bias,  b. 
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TABLE  A-2 . LIST  OF  CONSTANTS 


A3?  = Decimal 

OcJ'al 

A32  = 0.17022 

0.12712 

A.„  = 0.01787 

0.01112 

B , = 0.01400 

0.00713 

B21  = 0.18942 

0.14077 

B = 0.01919 

0.01165 

B.  = 0.00132 
41 

0.00053 

C = 0.09672 

0.06141 

C22  = 0.00505 

0.00245 

C32  = 0.54627 

0.42754 

D = 0.44868 

0.34556 

E u = 0.13538 

0. 10524 

E. . = 0.43066 
zz 

0.33438 

E32  = 0.42476 

0.33136 

F = 0.14458 

0.11202 

g = 1.0000 

1.0 

Kx  = 0.06667 

0.04211 

K2  = 4.0000 

4.0 

K3  = 0.26667 

0.21042 

K,  = 2.4000 

2.3146 

K5  = 141.67 

215.53 

VL  = 22.399 
6 

26.314 

K?  = 2.5000 

2.4 

K0  = 92.908 
0 

134.72 

= 40.323 

50.645 

K Q = 0.60000 

0.46315 
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XII. 


Glossary 


*1N  " Xl/K 

Updated  state  variable 

X1L  " x:?l 

Stored  state  variable 

Bll»  ®2l * 331’  B41*  A32j  A42 

q/r  channel  transition/control 
matrix 

^'qL  ^rL 

Inputs  from  seeker 

g 

Gravity  bias  constant 

yqNJ  yrN 

Updated  q/r  channel  variables 

yqL*  yrL 

Stored  q/r  channel  variables 

ZqN’  ZrN 

q/r  channel  outputs 

h>  «2>  K3>  K4 

q/r  channel  gain  constants 

Pitch/yaw  compensator  inputs 

V V \ 

Pitch/yaw/roll  gyro  measurements 

V °22’  C32J  °31 

Pitch/yaw  compensator  transition/ 
control  matrix  elements 

K5  ’ K6  * *S 

Pitch/yaw  channel  gain  constants 

ylN’  y2N 

Updated  pitch/yaw  variables 

ylL5  y2L 

Stored  pitch/yaw  variables 

Z1N’  Z2N 

Pitch/yaw  compensator  outputs 

EX1’  E22’  E32’  r31 

Roll  compensator  transition/control 
matrix  elements 

y3N 

Updated  roll  compensator  variable 

y3L 

Stored  roll  compensator  variable 

Z3N 

Roll  compensator  output 

C , C 
q r 

Seeker  q/r  signal  crossover 
discretes 

D 

Indirect  fire  target  detection 

discrete 
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Appendix  B.  LOOP  MODELLING  AND  ANALYSIS 


The  factors  of  interest  in  the  modelling  and  analysis  work  are  the 
crossover  frequencies  for  the  seeker  loops  and  gyro  loops,  the  analog 
system  frequency  response  roll-off  beyond  crossover,  and  the  frequency 
characteristics  of  the  internal  seeker  electronics.  A single  channel 
seeker  loop  block  diagram  is  shown  in  Figure  B-l  and  a similar  diagram 
is  shown  in  Figure  B-2  for  a gyro  loop.  Models  used  for  the  various 
blocks  are  explained  in  the  following  paragraphs. 


1.  Guidance  Filter 


The  guidance  filter  model  is 


Fx(s)  = 


(B-l) 


2.  Seeker  Filter  Integrator 

The  filter  integrator  model  is 


F2(s)  = 


3.  Pitch  Yaw  Gyro  Compensator 

The  pitch  yaw  compensator  model  is 


(B-2) 


(B-3) 


53 


Figure  B-2.  Gyro  loop. 
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4.  Roll  Gyro  Compensator 

The  roll  gyro  compensator  model  is 


(B-4) 


5.  Actuator  Model. 

The  actuator  model  was  taken  from  North  American  Rockwell 
document  772-SA -20-72 , "Scaled  Down  THFTV  Autopilot  Requirements."  The 
transfer  function  is 


The  frequency  w was  given  as  a function  of  dynamic  pressure  which  was 
converted  to  Mach  number  (Table  B-l). 


TABLE  B-l.  ACTUAL  MODEL  DATA 


Dynamic  Pressure 
(lb/ft2) 

w 

A 

(rad/sec) 

Mach  No. 

237 

30 

0.4 

1200 

26 

0.9 

1795 

24 

1.1 

2900 

20 

1.4 

4230 

16 

1.7 

The  u versus  Mach  number  tabulation  was  later  used  to  get  approximate 
values  of  for  Mach  numbers  at  which  aerodynamic  data  were  available. 
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6. 


Missile  ? itch/Yav  Model 


The  missile  response  was  modelled  by  the  function 


values  for  K and  w were  calculated  from 
P P 


K 

P 


2 V C 


£b 


d C 


2p 


P 


,20 

qSd  CiP 

21  V 
P 


(B-6) 


(B-7  ) 


for  which  information  on  aerodynamic  coefficients,  effective  area, 
effective  length,  and  moment  of  inertia  was  taken  from  MICOM  Technical 
Report  RG-73-18  "T6  Missile  Desc^mtion. " Resulting  values  are  shown 
in  Table  B-2. 


TABLE  B-2.  MISSILE  PITCH  YAW  DATA 


Mach  No. 

“a 

K 

P 

u> 

P 

0.5 

29 

253 

0.31 

0.9 

26 

467 

0.57 

1.3 

21 

619 

0.81 

7.  Missile  Roll  Model 

The  missile  roll  response  was  modelled  by  the  function 

*R 


FR  = 


(B-8) 


Values  calculated  for  and  are  shown  in  Table  B-3. 


R 
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TABLE  B-3.  MISSILE  ROLL  DATA 


Mach  No. 

Li 

A 

*R 

0.5 

29 

1286 

0.62 

0.9 

26 

2527 

1.15 

1.3 

21 

4183 

1.62 

8.  Gyro  Model 

The  gyro  transfer  function  was  taken  to  be  unity  since  no 
better  information  was  available  (See  North  American  document  772-SA- 
20-72). 


9.  Seeker  Model 

The  sampled  data  seeker  model  was  based  on  the  equation 


y(S)  - 


) U-'(s) 
GH*(s ) 


in  which 


1 

u*(s)  = “ Z u (s  + j mi ) 


From  document  772-SA-20-72 

G(s) 


■ l1^1)  (°-5  + f) 

GH*(s)  G(s)}  * 


From  available  tables 


"1  I 0 5T  v 2^  z^z+^-) 

GH*(s)  = (1  - z M - + r— 

1 (2  - 1)  (2  - ir 
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i 

j 


l 

3 

\ 


sT 

in  which  z = e . The  fundamental  response  was  computed  from 


r ( i.j'N  = •L  ( icjl  = — -l^i) 

‘s(j  } u } T 1 + GH*( ju)  ’ 
an  approximate  analog  model  ignoring  the  sampler  is 


(B-14) 


F (s) 
s 


fell 


— + — + 1 
5 10 


(B— 1 5) 


Open  loop  break-point  frequency  response  plots  are  shown  in 
Figures  B-3  and  B-4  using  data  at  Mach  0.9  and  Equation  (B-15)  for  the 
seeker.  Actual  response  data  obtained  by  programming  the  model  equations 
including  Equation  (B-14)  for  tne  seeker  yielded  crossover  frequency 
information  in  Table  B-4. 


TABLE  B-4.  CROSSOVER  FREQUENCY  DATA 


Mach  No. 
Mach  No. 

fe; 

(rad/sec) 

Phase  Margin 
(deg) 

Gain  Margin 
(dB) 

0.5 

15 

19 

23 

P/Y  0.9 

29 

26 

13 

1.3 

41 

24 

9 

0.5 

23 

18 

17 

Roll  0.9 

51 

21 

7 

1.3 

88 

10 

1 

0.5 

13 

13 

7 

Seeker  0.9 

18 

-8 

-4 

1.3 

- 

21 

-20  ' 

i 

i 

-12 

According  to  these  data,  none  of  the  system  phase  margins  are  very 
reassuring.  The  seeker  loop  appears  to  be  unstable  at  the  upper  Mach 
numbers.  A contributing  factor  to  this  condition  is  the  zero  order 
delay  in  the  internal  seeker  electronics  which  contributes  20  to  30 
degrees  of  lag  at  the  indicated  crossover  frequencies.  Some  of  this 
delay  could  be  compensated  for  by  the  microprocessor  software.  A time 
varying  gain  program  in  the  microprocessor  would  also  help  to  improve 
system  per  form.' nee  and  stability. 
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60 


It  can  be  seen  from  gyro  compensator  data  that  the  digital  system 
response  is  fairly  effective  up  to  the  complex  actuator  pole  break  at 
200  rad/sec.  Beyond  this,  loop  response  roll-off  is  so  rapid  that  it 
does  not  matter  what  the  digital  system  does. 

The  potential  seeker  sampler  sideband  problem  is  caused  by  the 
fact  that  inputs  at  the  digital  system's  data  rate  or  multiples  thereof 
will  cause  a bias  build-up  on  the  digital  integrator.  The  internal 
seeker  response,  calculated  using  Equations  (B-9)  and  (B-10),  is  shown 
in  Figure  B-5.  It  is  believed  that  the  best  that  can  be  done  to  choose 
the  integrator  update  interval  somewhere  between  the  sets  of  sidebands 
from  the  seeker  and  hope  that  nothing  exciting  happens.  A convenient 
interval  from  a computer  software  viewpoint  is  to  use  some  multiple 
of  the  shortest  update  interval  which  is  that  for  roll.  The  interval 
chosen  is  7 roll  cycles  or  14  milliseconds  which  corresponds  to  about 
71.4  Hz.  This  is  about  midway  between  the  sidebands  at  60  to  80  Hz. 

The  seeker  gain  at  this  frequency  is  -27  dB  or  0.045  which  means  that 
bias  b’ild-up  at  the  rate  of  0.045  degree  per  second  of  flight  time 
per  degree  of  seeker  input  amplitude  at  71.4  Hz  could  occur.  With  a 
loop  gain  of  about  -100  dB,  however,  disturbances  at  71.4  Hz  should  not 
be  a problem.  There  is  not  much  computation  time  to  be  gained  by  split- 
ting the  seeker  filter/integrator  software  into  more  roll  cycles  than 
seven. 
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